#include "../udp/Package.h"

#define PI 3.14159265
#define MAXSPEED 100
#define MINSPEED 20

#define MAXROTSPEED 75 
#define MINROTSPEED 20

#define TRESH_DISTANCE 70
#define TRESH_THETA 90
#define TRESH_STOP  46
#define TURN_DEGREE 4 

class RobControl {
    double direction_vector_x;
    double direction_vector_y;

public:
    void set_vector (int,int);
    double get_vector_x ();
    double get_vector_y ();
    bool isValidCoords(Info coord);
    double turn_calculate(double,double,double,double,double);
    double calc_distance(double,double,double,double);
};
